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raum 



KoHisionsgefahrerkennung bei Handhabungtteinrichtungen mit gemelnsamem Arbelts- 



(65) geometrischer Korper: Handhabungselnriclrtung: 
hierarchisches System; Industrieroboter; Kollision; 
Kollisionsschutz; Koordinaten; Mehrrechnersystem; 

prismatischer Korper; Zylinder 

(57) Die Erfindung betrifft ein Verfahren zur 
Kollisionsgefehrerkennung bei Handhabungseinrichtungen 
mit gemeinsamem Arbeitsraum. das mit Vorteil fur den 
Einsatz von n a 2 Industrierobotem mit einem 
gemeinsamem Arbeitsraum eber mit vonelnander 

unabhanginon Hendlungen oder euch bei kooperativen 
Handlungen zum Kollisionsschutz geeignet ist. Die 
Anwendung des Verfahrens ist auoh in modifizierter Form 
z. B. fur Bagger, Krene und F6rdereinrichtungen unter 
aquivalenten Bedingungen m5glich. ErfindungsgemiB wird 
die Aufgabe dadurch gelost. daft fur die 
Handhabungseinrichtungen pasrweise rekursiv 
koMisionsgef ahidete Teile bestimmt werden, die durch 
einfache geometrische Modelle, z. B. prismatische Korper 
Oder Zylinder, umschrieben werden. Die Parameter der 
Umschreibungen, z. B. die Kantenlangen oder 
Durchmesser, hangen von der Stellung der 
Handhabungseinrichtungen ab. Die rechnerlsche 
Auswertung gjschieht paarweise. indem Relationen 
zwischen den Koordinaten der Begrenzungen dieser beiden 
Umschreibungen hergestellt werden. Dabel wird nach einer 
Tangierung oder Oberschneidung der Modelle gesucht. Die 
Erfindung ist an Fig. i ersichtlich. Figur 
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.Patentanspruche: 

1 Verfahren zur Kollislonsgefahrerkennung bel Handhabungseinrichtungen mit gemeinsamem 
' Arbeitsraum, dadurch gekennzelchnet, daB fOrdie-Handhabungseinrichtungen paarweise rekursiv 
kollislonsgefahrdete Teile bestimmt werden. deren Umschreibung durch einfache geometrische 
Modelle, z. B. prismatischa Kdrper oder Zylindar, erfolgt, die Parameter der Umschreibungen, z.B. 
Kantenlangen oder Durchmesser, von der Stellung der Handhabungseinrichtungen abhangen, 
wobei die ?ich fQr den nachsten Rekursionsschrltt ergebenden kollision^ 

Handhabungseinrichtungen, die wiederum zu umschreiben sind, innerhalbdes Schnittgebildes 

dieser Umschreibungen befinden. .... u u „r? „ tr ^ r 

2. Verfahren nach Anspruch 1, dadurch gekennzelchnet, daB durch em VorhaltemaB elner 

vorliegt, wenn die letzten Umschreibungen der kollisionsgefahrdeten Telle der zu flberwachenden 
Handhabungseinrichtungen keine gemeinsamen Koordinaten besitzen. 

4 Verfahren nach Anspruch 1, dadurch gekennzelchnet, daB die Bedingung „Kollisionsgefahr dann 
vorltaQt, wenn nach dem Abbruch der rekursiveh Berechnungen auf Grund emer bestimmten 
Schrittanzahl oder der Gr6Be eines geometrischen Modells die letzten Umschreibungen der 
kollisionsgefahrdeten Teile derzu Gberwachenden Handhabungseinrichtungen gemeinsame 
Koordinaten aufweisen. 

5 Verfahren nach Anspruch 1, dadurch gekennzelchnet, daB die rekursive Bestimmung 

' kollisionsgefahrdeter Telle mit der Erfullung eines bestimmten Krlteriums, z. B. etner bestimmten 

Schrittanzahl, abgebrochen wird und anschlieBend ein Kollisionsgefahrtest fur die zuletzt 
bestimmten kollisionsgefahrdeten Teile der Handhabungseinrichtungen nach einem bekannten 
Verfahren, z. B. einem Abstandstest, erfolgt. - „ ^ 

6 Verfahren nach Anspruch 1 bis 5, dadurch gekennzelchnet, daB fur die Durchf Qhrung des 
Verfahrens ein hlerarchisches Rechnersystem bestehend aus elner Vergleichsemhelt und n 
Transformationsrechnern eingesetzt wird. 

Hierzu 1 Seite Zeichnungen 
Anwendungsgeblet der Erf in dung 

Die Erf Indung betrifft ein Verfehren zur Kolllstonsgefehrerkennung bei Hendhebungselnrtchtungenrnlt gemeinsamem 
Arbeftsraum. das mil Vorteil fOr den Einsetz von n * 2 Industilerobotern mit elnem gemeinsamen Arbeitsraum aber mit 
voneinonder unabhln 0 t 0 en Handlungen oder auch bel kooperatlvan Handlungen mm Kollislonsschutz geetgnet 1st. Die 
MweVdung des Verfenrens 1st auch in modiflzlerter Form z.B. fur Bagger. Krene und Forderetnrichtungen enter aqulvatenten 
Bedingungen mdgllch. 

Charekter Istlk der bekannten technlschen Losungen 

In der Robotertechnlk und in der Bauindustrle aind verschledene Verfahren zum Kofflslonsschutz bekannt 
H |fevonStart-«5top-Stgnelenv«rdgowe^^^^^ 

oemeinsame ArbellaTeum kann auch in TellarbeitsrBumezerlegt warden. Ein Nachtell deaVerfahrens besteht darin daB lange 
Wsrtezeiten auftreten kfinnen. wenn keine Unterteilung des gemeinsamen AAeltsraumes vorgenommen ^ •** 
Festlanuna von Tellarbettsrflumen erh8ht slth der Hardware- und dar Auawerteaufwend. In der Patantachrlft DD-WP 226270 
wird ein Verfahren zur Kollislonsgefahrerkennung bei Kronen vorgestellu Ea beruht auf der Festlegung von Qrenzwerien. See 
werden durch Indirektes .Teach-In" g B wonnen und einem Rechner uborgeben, der sie stfindig mit den ektuellen Koordinaten 
verolelcht und bel Kollialonagefahr Alarm aualost unddloKranbawegung stoppt. Dieses Verfahren versagt bei komplizierten 
Anordnungen und bel elner hohen Anzaht von Fraiheltagraden. Ea wurde nur fOr einfache Anwendungsfllle konzlplert 
Andere Verfahren und Einrichtungen. die ebeniallsZuaamm«nst8Be zwlschen Kranen > vemwiden, • beruho^n aul^n^satzvon 
Sensoren.Slewerdenin den Patenlschrifton DD-WP 144161,Dr>WP 0161731.DE-PS 2750308 und DE-OS 3241 900 beschrieben. 
Dabei erfolgt elne Bestimmung des Abstandes der Krene mit Hilfe von Sendern. Reflokioren und Empfengern. Be 
Unterschreitung eines Mindestabatandoa wird Alarm auageWst und die Lelstung der Antrlebe abgeachaltet Der Nachteil dieser 
Verfahren und Einrichtungen besteht darin, daB schienengebundene Handhabungseinrichtungen voreusgesetzt warden und 

nureinFreihehsgradindieAuawertungelnbezogenwIrd. 

Zwel Verfehren, dla In elner Dissertation (Hover. H.: Verfahren zur automatlschen Kollislonsvermeldung von Robotem Im 
koordiniertenBetrieb.-Dls8erl8tionAFernUnrverstt8tHagen. 1984) vorgestellt werden, besleren auf derBerechnungvon 
Kolllslon8schu1zparametern,dievonderUgaderr^^ 
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dann werden MaBnahmen zum Kollislonsschutz eingeleltet Die Verfahren slnd stark andiekonkrete Robotarstruktur gehunden. 
In die Auswertung werden nur die Greiferspltzen elnbezogen. 

EineTaaunflsverdffentlichung (Yuh J.: On-line Adaptive Collision Avoidance Motion Control Strategy For Two Planar Robots.- 
Proceeding Tof the IEEE International Conference on Systems, Man, and Cybernetics.- Alexandria, 20-23 October 1987.- pp.2i- 

25) onthfilt elnen Beitrag zum On-line-Kolltsionsschutz, verbunden mlt einer Steuerstrategie ttr zwei planare Roboter. Die 
Greifersptae des hdherpriorislerten Roboter* bewegt slch entlang einer Geraden vom Start- zum Zielpunkt. Parallel zu dieser 
Verblndungsstrecke wird unter Beachtung elnes Slcherheltsabstandes elne Geradefestgelegt. Dabei entstehenzwel Gebiete. 
Bewegt slch der ntederpriorislarte Roboter in das Koliisionsgeblet, wird eln Soll-Wert enllang der Begroruungsgeraden 
festgelegt Dieses Verfahren setzt lineare Bewegungen der Greif erspitzen der Roboter voraus und wurde nur f Or planare Roboter 
entwickelt. 

Zlel darErflndung 

DasZiel der Erfindung besteht darin, eln Verfahren vorcustellen, daft elne Kollislonsgefahr zwischen 
Handhabungselnrichtungen, die elnen gemeinsamen Arbeitsraum besltzen, erkennt und eine Kollision ausscnileBt. 

Darlegung des Wesen* der Erfindung 

Es 1st die Aufgabe dar Erfindung, ein Vorfahran *u' KolUsionsgelahrerkennung fur Handhabungselnrichtungen mil 

g emelnsamemArbeiteraumanzugeben,bei^^ 

elnfache geometrische Modelle verwendet werden. Dabei soli eine paarwelse Auswertung zwischen zwei 
Handhabungselnrichtungen erfolgen. Als Mittel werden Handhabungselnrichtungen mlt MeBsystemen und Rechnersystemo 
alsAuswerteeinheiteneingesetzt.ElneKollision der Handhabungselnrichtungen soil ausgeschlossen werden. ErfindungsgemaB 
wird die Aufgabe dadurch geldst, daB f Or die Handhabungselnrichtungen paarwelse rekursiv koliislonsgefahrdate Telle . 
bestimmt warden, die durch einfache geometrische Modelte, z.B. prismetlsche Kurper oder Zylinder, umschrieben warden. Die 
Parameter der Umschreibungen, z. B. die Kantenlflngen oder Durchmesser, hlngen von der Stellung der 
HandhabungseinrlcMungen ab. Die rechnerische Auswertung gaichieht paarwelse, indem Relationen 2wischen den 
Koordinaten der Begrenzungen dieser belden Umschreibungen hergestellt werden. Dabei wird nach elnarTangierung oder 
Oberschneidung der Modelle gesucht. Dlese Verf ahrensweise entspricht der Durchschnittsbildung von zwei Mengen M, Ma> 
Damit werden die kollisionsgefahrdeten Telle for den nachsten Rekurslonsschrrtt bestimmt. Sie ergeben slch bus den Teiten der 
Handhabungselnrichtungen, die sich innerhalb des Schnittgebildes befinden. Sle werden erneut umschrieben. Durch ein 
VorhaltemaS wird einer Tanglerung vorgebeugt. Es berOclcslchtlgt das Bremsverhalten und wird aus den MeBgrdften fur die zu 
Oberwachenden Handhabungselnrichtungen bestimmt. 

Die Bedingung .koine Kollislonsgefahr- 1st erfQItt, wenn die letzten Umschralbungen der zu Oberwachenden 
Handhabungselnrichtungen keino gemeinsamen Koordinaten besitzen. Die rekursh/e Bestlmmung kolllsionsgefahrdeter Telle 
wird abgebrochen, wenn eln bestimmtes Krlterlum erf Ollt wird, *. B. elne meximate Schrrttanxahl e rrelcht ist Oder die 
geometrischen Modelle elne bestimmte Gr5Be unterschrelten. Die Bedingung .Kollislonsgefahr'' Ist erfullt, wenn die letzten 
UmschreibungenderkolllslonsgefahrdetenTO^^ 

aufweisen. In dtesem Fall sind MaBnahmen zur Kolllslonsverhatung elnzutelten. Andererselts kann nach dem Abbruch der 
Rekurslon auch ein bekanntes Verfahren zum Kollisionsgefahrtest fOr die zuletzt bestimmten kollisionsgefahrdeten Teile der 
Handhabungselnrichtungen, z.B. eine Abstandsbestlmmung, verwendet werden. 

Die Ausf Ohrung des Verfahrens erfolgt unter der Nutzung eines hlerarchischen Rechnersystems bestehend aus einer 
Rechnereinhelt und nTransformationsrechnern. Ein Sicherheitsabstand kann elngefflhrt werden durch eine virtuetle 
Vergr6&erung der Handhabungselnrichtungen oder der Umschreibungen. Sollten bestimmte technologische Bedingungen die 
Abschaltung der Auswertung fur rwel Handhabungselnrichtungen erforderltch machert, so 1st elne paarweise DeaktivSerung 
notwendig. 

Ausfflhrungsbeisplel 

Die Erfindung soli nachfolgend mlt einem Ausfflhrungsbeisplel nlher erlHutert werden. In den Zeichnungen zeigan 

Fig. 1 : das Prlnzip der KoUislonsverhOtung mlt den Umschreibungen durch geometrische Modelle fOr zwei Industrleroboter mil 

Fig. 2: und Bestlmmung der Umschreibungen der geometrischen Modaile. 

Die Auswertung der Kollisionsverhutung erfolgt in zwei Schritten. Zuerst bestimmendieTransformattonsrechner<Flg.2)asuden 
aktuellen und den vorherlgen Posltionswerten die Geschwindigkelten der Roboterglieder, Sle dienen der Bestlmmung der 
VorhahemaBe. Daraufhln werden die geometrischen Modelle der Industrleroboter mlt Hllfe der Transformationsrechner unter 
Nutzung der aktuellen Koordinaten und der berechneten VorhahemeBe In eln ortsfestes Verglefchskoordinstensystem 
transformiert Dem schlieBt eich die Bestlmmung der I.Umschrelbungen Oh 0) fOr die Industrleroboter an. Dazu werden zwei 
Ebenen berechnet, die Jewells zwei Gebiete festlegen. Elnes der belden Gebiete enthfilt den zugehSrigen IndusU eroboter 
vollstfindig.DleEbenenstehensenk^^ 

gemeinsamen Punkte mlt dem entsprechenden Roboter und nehmen zu Ihm elnen bestimmten SkhBrh eltsabsta nd eln. Unter 
bestimmten Bedingungen trltt eine Oberlappung der I.Umschrelbungen (6) auf. Ist das nlcht der Fall, beginnt die Auswertung 
von vorn. Der Uberf appungstest erfolgt in der Vergleichseinheit (Fig. 2), der die berechneten Parameter von den 
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Tranaformatlonorechnern erhah und ate fib die Barechnung der fcUmschrelbungen (2). (4) an dan Jewella anderan 
U^applgiabafindeam^ 

wtedSn barechnaten Kann„r«Ban an die Vorglalchsalnhalt. Ste teatat. ob sich die iwai Quadar achnelden. 

Obermhtelt. Basteht kalne Kotlislonsgefahr, beglnnt Jle Auswertung von vorn. 
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